arXiv:1505.06845vl [cs.RO] 26 May 2015 


Proceedings of the ASME 2015 International Design Engineering Technical Conferences & 

Computers and Information in Engineering Conference 

IDETC/CIE 2015 
August 2-5, 2015, Boston, USA 


DETC2015/MR-46292 


KINEMATIC ANALYSIS AND TRAJECTORY PLANNING OF THE ORTHOGLIDE 

5-AXIS 


S. Caro, D. Chablat, P. Lemoine, P. Wenger 

Institut de Recherche en Communications et Cybernetique de Nantes (IRCCyN) 

(UMR CNRS 6597) France 
Emaii addresses: 

{Stephane.Caro, Damien.Chabiat, Phiiippe.Lemoine, Phiiippe.Wenger}@irccyn.ec-nantes.fr 


ABSTRACT 

The subject of this paper is about the kinematic analysis and 
the trajectory planning of the Orthoglide 5-axis. The Orthoglide 
5-axis a five degrees of freedom parallel kinematic machine de¬ 
veloped at IRCCyN and is made up of a hybrid architecture, 
namely, a three degrees of freedom translational parallel manip¬ 
ulator mounted in series with a two degrees of freedom parallel 
spherical wrist. The simpler the kinematic modeling of the Or¬ 
thoglide 5-axis, the higher the maximum frequency of its control 
loop. Indeed, the control loop of a parallel kinematic machine 
should be computed with a high frequency, i.e., higher than 1.5 
MHz, in order the manipulator to be able to reach high speed 
motions with a good accuracy. Accordingly, the direct and in¬ 
verse kinematic models of the Orthoglide 5-axis, its inverse kine¬ 
matic Jacobian matrix and the first derivative of the latter with 
respect to time are expressed in this paper. It appears that the 
kinematic model of the manipulator under study can be written in 
a quadratic form due to the hybrid architecture of the Orthoglide 
5-axis. As illustrative examples, the profiles of the actuated joint 
angles (lengths), velocities and accelerations that are used in the 
control loop of the robot are traced for two test trajectories. 


INTRODUCTION 

Parallel kinematics machines become more and more pop¬ 
ular in industrial applications.This growing attention is inspired 
by their essential advantages over serial manipulators that have 


already reached the dynamic performance limits. In con¬ 
trast, parallel manipulators are claimed to offer better accuracy, 
lower mass/inertia properties, and higher structural stiffness (i.e. 
stiffness-to-mass ratio) Q. These features are induced by their 
specific kinematic architecture, which resists to the error accu¬ 
mulation in kinematic chains and allows convenient actuators lo¬ 
cation close the manipulator base. Besides, the links work in par¬ 
allel against the external force/torque, eliminating the cantilever- 
type loading and increasing the manipulator stiffness. 

Unlike the Variax proposed by Gidding & Lewis in Chicago 
in 1994, the delta robot invented by Clavel |[T] has known a great 
success for pick and place applications. One reason for this suc¬ 
cess is the simplicity of the kinematic and dynamic models com¬ 
pared to the models of the Gough-Stewart platform Q. Indeed, 
the performance of parallel robots may vary considerably within 
their workspace, which is often small compared to the volume 
occupied by the machine. It is noteworthy that the inverse kine¬ 
matics of a parallel manipulator is usually easy to calculate when 
the actuated joints are prismatic joints as the corresponding equa¬ 
tions to be solved are quadratic. However, the inverse Jacobian 
matrix of such manipulators is more difficult to express and its 
computing time higher. Several five degrees of freedom (dof) 
parallel manipulators have been synthesized in the literature the 
last few decades. However, their complexity make them difficult 
to build and use in general. Moreover, the use of fully parallel 
manipulators leads to robots with five limbs whose mutual col¬ 
lisions or geometric constraints reduce the workspace size. The 
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Tripteron is one of the simplest translational parallel robot with 
three degrees of freedom that can be found in the literature Q. 
However, this architecture is not suitable for machining opera¬ 
tions since its legs are subjected to buckling. 

As a consequence, a five dof hybrid machine, named Or¬ 
thoglide 5-axis, has been developed at IRCCyN. This machine is 
composed of three dof translational parallel manipulator, named 
Orthoglide 3-axis, mounted in series with a two dof spherical 
parallel manipulator, named Agile Eye 2-axis. The Orthoglide 
3-axis has the advantages of both serial and parallel kinematic 
architectures such as regular workspace, homogeneous perfor¬ 
mances, good dynamic performances and stiffness. The interest¬ 
ing features of the Orthoglide 3-axis are large regular dextrous 
workspace, uniform kinetostatic performances, good compact¬ 
ness p~3| and high stiffness | |T4| . Besides, the translational and 
rotational motions of the end-effector (tool) are partially decou¬ 
pled with the hybrid architecture of the Orthoglide 5-axis. 

This paper is organized as follows. The next section deals 
with the kinematic modeling of the Orthoglide 5-axis. Then, 
some trajectories are generated using a simplified computed 
torque control loop and tested experimentally. Finally, some con¬ 
clusions and future work are presented. 


THE ORTHOGLIDE 5-AXIS 
A hybrid architecture 

Figure [T] depicts a CAD modeling of the Orthoglide 5-axis 
and figure shows a semi industrial prototype of the Orthoglide 
5-axis located at IRCCyN. The Orthoglide 5-axis is a hybrid par¬ 
allel kinematics machine (PKM) composed of a 3-dof transla¬ 
tional parallel manipulator, the Orthoglide 3-axis, mounted in se¬ 
ries with two dof parallel spherical manipulator, the Agile Eye 2- 
axis. The Agile Eye 2-axis is spherical wrist developed at Laval 
University Q. The architecture of the Orthoglide 5-axis was 
presented in as well as in Q. 



FIGURE 1. Digital mock-up of the Orthoglide 5-Axis 



FIGURE 2. Semi industrial prototype of the Orthoglide 5-Axis per¬ 
forming a machining operation 


Orthoglide 3-Axis 

The Orthoglide 3-axis is composed of three identical legs. 
Each leg is made up of a prismatic joint, a revolute joint, a paral¬ 
lelogram joint and another revolute joint. The first joint, i.e., the 
prismatic joint of each leg, is actuated and the end-effector is at¬ 
tached to the other end of each leg. Hence, the Orthoglide 3-axis 
is a PKM with movable foot points and constant chain lengths. 

The kinematics of the Orthoglide 3-axis was defined in Q. 
Let p = [pi p 2 denote the vector of linear joint variables and 
p = [v y z\' denote the Cartesian coordinate vector of the position 
of the end-effector. The loop closure of the Orthoglide 3-axis 
leads to the following three constraint equations; 

{x — pi)^+y^ + = li (1) 

x^ + {y-P2f+z^ = ll ( 2 ) 

+ y'^ + (z — Pi)^ = 1$ (3) 

Therefore, the inverse Jacobian matrix of the Orthoglide 3- 
axis takes the form; 
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It appears that the Orthoglide 3-axis can have up to two assembly 
modes, i.e., two solutions to its direct geometric model, and up to 
eight working modes, i.e., eight solutions to its inverse geomet¬ 
ric model. Moreover, those solutions can be easily obtained by 
solving simple quadratic equations 112|. The lengths of the par¬ 
allelogram joints and the joint limits were obtained by using the 
method presented in Q in order the manipulator to get a cube¬ 
shaped translational workspace of 500 mm edge. 












Agile Eye 2-axis 

Figure [^illustrates a spindle mounted on the two dof spher¬ 
ical parallel manipulator, the latter being mounted in series on 
the Orthoglide 3-axis in order to get the Orthoglide 5-axis. The 


function of angles a and j3 as follows: 


Prr = 


-sin(^) 
sin (a) cos (j3) 
— cos (a) cos (j3) 


(5) 



The actuated joint angles 0i and 02 are expressed as a function 
of angles a and j3 as follows: 


01 = — arctan 
02 = arctan 


— sin(a)cos(j3) 
cos(a)cos()3) 
sin(^) 


cos(a)cos(j3) 


(6) 

(7) 


The inverse kinematic Jacobian matrix, *, of the parallel 
spherical manipulator is expressed as: 


1 0 
50250iCj3 5j3C0i502 + C02Cj3 

5)3502+ C0iCj3C02 5)3502 -I- C0iC)3C02 


( 8 ) 


Agile Eye 2-axis, namely the two dof spherical parallel manipu¬ 
lator, consists of a closed kinematic chain composed of five com¬ 
ponents: the proximal 1 link, the proximal 2 link, the distal link, 
the terminal link and the base. These five links are connected 
by means of revolute joints, the two revolute joints connected 
to the base being actuated. Let us notice that all revolute joints 
axes intersect. The shape of the proximal and distal links were 
determined in GD in order the wrist to have a high stiffness. 

The kinematics of the Agile eye was defined in ||^. Note 
that the orientation workspace of the Orthoglide 5-axis is limited 
to ±45 degrees due to mechanical constraints. For machining 
operations, the orientation of the tool is defined by two rotation 
angles a and )3 rotating respectively around the x and y axes. 
A IBAG spindle HFK 95.1 is mounted on the spherical wrist. 
Its power is equal to 1 KW and its maximum speed is equal to 
42000 rpm. The distance / between the tool tip and the geometric 
and rotation center of the wrist should be higher than 72 mm (I > 
72mm). 

The geometric, kinematic and dynamic models of the Agile 
Eye 2-axis are given in 0. Here, its inverse Jacobian matrix is 
recalled in order to compute the velocity of the geometric center 
of the wrist with respect to the tool tip and the corresponding 
actuated prismatic joint rates of the Orthoglide 3-axis. 

The Agile Eye admits two assembly modes that are easily 
obtained and discriminated by solving a quadratic equation. The 
Cartesian coordinate vector p„ of the tool tip is expressed as a 


where C0, = cos(0,), 50, = sin(0,), Ca = cos(a), Sa = sin(a), 
C)3 = cos()3), 5)3 = sin()3) and 
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The relation between the Cartesian velocities of the geometric 
center of the spherical wrist and the output angle rates is given as 
a function of the tool length / by: 
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with 
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Coupling two parallel robots 

The assembly of two parallel robots in series leads to a sim¬ 
ple kinematic model of the Orthoglide 5-axis. Indeed, the direct 
kinematics of the latter is obtained by solving first the direct kine¬ 
matics of the Orthoglide 3-axis in order to get the Cartesian coor¬ 
dinates of the geometric center of the spherical wrist and then by 
calculating the direct kinematics of the spherical wrist in order to 
express the pose of the tool. About the inverse kinematics of the 
Orthoglide 5-axis, the inverse of the spherical wrist is first solved, 
then the inverse kinematics of the Orthoglide 3-axis is solved. It 
is noteworthy that a translational motion of the geometric center 
of the wrist does not change the orientation of the tool. However, 
a rotation of the tool about its end leads to translational displace¬ 
ment of the geometric center of the spherical wrist and as a result 
to actuated prismatic joint displacements. The inverse kinematic 
modeling of the Orthoglide 5-axis is expressed as: 


the translational motions are expressed as follows: 

Tfl = 7 {di+Kp^{df - di)+KD^{df - di)+Ki^ £ {df - 0,)) 
Tt=M (^pj + Kp^ {pj -pj)+ Kd^ (pJ -pj)+ % £ {pj -pj)^ 

for i= 1..2, j = 1.3, J = 0.2772 Kg.m^, M = 91.6278 Kg, 9f 
and of denote the prescribed actuated joint angles and rates. 9i 
and 0, denote the actual joint angles and rates. The values of co¬ 
efficients J and M mainly depend on the motor inertia, the gears 
and the axis of the ball screws. Note that the effect of the inertia 
and mass of the elements in motion is somehow the correspond¬ 
ing inertia and mass divided by the square of the gearhead ratio. 
As a result, for the rotational and translational parts, we obtain: 


q = J ‘t 


( 12 ) 


n T 


where q = [0i 02 pi pi pi] and t = a $ xy z ■ We can de¬ 
scribe the inverse Jacobian matrix as three sub-matrices coming 
from the both parallel robots. 
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as IS written in 


14| Note that the first derivative of J ^ with 


respect to time can be easily obtained by using a symbolic com¬ 
putation software. However, its expression is too lengthy to be 
displayed in the paper. 


TRAJECTORY GENERATION 

The trajectory planning approach described in | [T0| has been 
used for the trajectory generation of the Orthoglide 5-axis. Note 
that the trajectories are defined in the task space, i.e., the robot 
workspace, whereas the control loop requires data in the joint 
space. According the design rules presented in |[^, the bound¬ 
aries of the Orthoglide 3-axis workspace are defined in the Carte¬ 
sian space. Therefore, the direct kinematics is computed at the 
frequency of the control loop in order to check whether the 
moving-platform of the robot is within its Cartesian workspace 
at anytime or not. 

Here, the system dynamics is decoupled in order to consider 
five separate actuators moving an equivalent mass and analyze 
the stability of the system. In the robot control scheme, the dy¬ 
namic effects have been taken into account in order to improve 
the classical PID control scheme. Therefore, the torque T p asso¬ 
ciated to the rotational motions and the torque Tj- associated to 


(0—49 rad/s 
Kp^ =Kp^= 30)2 ^ J9200 
Kv^ = Kvr =3(0 = 240 
Kj^ = Ki^ = 0)2 =512000 (15) 

where O) is a function of the torque constant, the dielectric con¬ 
stant, the motor efficiency and its inertia. Figure shows the 
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FIGURE 4. Control scheme of the Orthoglide 5-Axis 


control scheme of the Orthoglide 5-Axis. 

Control hardware and control loop 

The control hardware of the Orthoglide 5-axis is a 1103 
DSPACE card pT) with a 933 MHz PowerPC. The actuator posi¬ 
tions are acquired with a frequency equal to 9 kHz and a 200 Hz 
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low pass filter is used to compute the actuator velocities. The 
robot motions are controlled thanks to a sub program working 
at 1.5 KHz. This program manages the control loop, the in¬ 
put/output relation and the security system. For instance, if the 
positional error of the end-effector is larger than 3 mm, the ma¬ 
chine will shutdown. Another level of security is on the actua¬ 
tors with electrical sensors stroke end. If enabled, neither the PC 
nor the Dspace card operates, it amounts to the cable security. 
The robot trajectories are calculated using Matlab and sent to the 
Dspace card via an optical fiber. In the Dspace card, the inverse 
Jacobian matrix is used when the robot is close to its workspace 
boundaries in order to know whether the Cartesian displacements 
of the end-effector lead to exceeding joint limits or not. 

A pneumatic compensator is mounted along the vertical axis 
in order to reduce the gravity effect. This compensator continu¬ 
ously generates an effort equivalent to the weight of the mobile 
platform, but in the opposite direction. The pressure in the cylin¬ 
ders is controlled by a purely mechanical system. 

Two types of motor are used for the actuated joints.Two Har¬ 
monic Drive FFA-20-80-H-E2048 are used to actuate the two-dof 
parallel spherical wrist and three Parvex Brushless NX430EAF 
coupled with Kinetic TDU 200 ball screws are used to actuate the 
three-dof translational parallel manipulator. As a consequence, 
the Orthoglide 5-axis can reach linear velocities up to 1 m/s and 
a linear accelerations up to 1 G. 

Note that the maximum angular velocity of the wrist motors 
is equal to 3.27 rad/s and their maximum angular accelerations 
is equal to 270 rad/s^. The maximum linear velocity of the pris¬ 
matic joints is equal to 1.2 m/s due to mechanical constraints and 
their maximum acceleration is equal to 13 m/s^ due to the value 
of the maximum continuous torques. 

Trajectories 

Three types of trajectories can be realized by the Orthoglide 
5-axis: 

1. The first trajectory is a linear interpolation between two pos¬ 
tures defined by two angles a and )3 and by three Cartesian 


coordinates x, y and z for which we can specify a velocity 
smaller than the maximum velocity, namely, a ratio of the 
maximum velocity. 

2. The second trajectory is a circle defined by a center point, a 
radius and a percentage of the maximum speed. The orien¬ 
tation of the spindle is changing linearly around the circle. 

3. The last trajectory is described by a G-code file. So far, only 
GOO and GOl functions have been implemented. The trajec¬ 
tory planner aims to keep the velocity between two postures 
constant. Some corners were added in order to smooth the 
path and avoid robot breaks. The radii of corner curvature 
are defined in order to use acceleration capacity of the ma¬ 
chine optimally and to minimize robot speed reduction. 

Eor all trajectories, a linear trajectory is automatically added 
between the current pose of the robot and its the starting point of 
the trajectory. Another linear trajectory between the final point of 
the trajectory and the current pose in order to close the loop. Eor 
safety reason, the actual speed is limited to 10% of the maximal 
speed during all trajectories. 

Eor the first two types of trajectory, a fifth degree polynomial 
equation is used to define the position r, the velocity r and the 
acceleration r along a linear interpolation: 

= a6) 

/(,)= 3 o (;;)- 6 o ( 0 + 3 og ) ( 17 ) 

7 (,) =60 (_.!)-180 (|,)+120 (^) ( 18 ) 

A computed torque control in the joint space is used. There¬ 
fore, the trajectory to be followed is projected into the robot joint 
space by using the inverse geometric model of the Orthoglide 5- 
axis, the inverse kinematic Jacobian matrix and its first time 
derivative j^*, in order to know whether the maximum motor 
velocities and accelerations are reached or not. 



Linear trajectory 

The computing traveling time depends on the total distance 
between the two robot poses. The minimum traveling time tj is 
defined as: 


tf = max 


ky-j, J 


(19) 


where \Dt \ is the norm of the Cartesian motion, | is the norm 
of the angular motion, ky^ and ky^ are the maximum linear and 
angular velocities. We can notice that these parameters are de¬ 
fined in the Cartesian workspace and will be larger if the maxi¬ 
mum joint velocity and acceleration are exceeded. Let Pi and P 2 
be the vectors defining the first pose and second pose of the robot 
end-effector, respectively. Any intermediate pose P is defined as: 


P(t)=Pi + (P2-Pi)r(t) (20) 

The velocity vector V(t) is expressed as: 

V(t)=f(t)(P2-Pi) (21) 

The acceleration vector A(t) takes the form: 


TABLE 1. Set of Orthoglide 5-axis end-effector poses used to define 
three linear trajectories 



Pi 

P 2 

P 3 

P 4 

a[degres] 

0 

20 

0 

0 

j3 [degres] 

0 

0 

20 

0 

3:[mm] 

0 

140 

-240 

0 

y[mm] 

0 

130 

-230 

0 

z[mm] 

-72 

60 

-180 

-72 



(a) Pi to P2 (b) P2 to P3 

FIGURE 5. Wrist angle and position of the end-effector along the 
linear trajectory 


A(t)=r(t)(P2-Pi) (22) 

The corresponding joint coordinate vector is obtained by: 

q(t)=f(P(t)) (23) 

with f denotes the inverse geometric model of the Orthglide 5- 
axis. The joint velocities are computed with the inverse kine¬ 
matic Jacobian matrix as: 

q(f)=J-iV(t) (24) 

The joint acceleration by using the inverse Jacobian matrix and 
its first derivation 

q(f)=r'A(f)-|-j-‘L(f) (25) 

Table[2defines a trajectory where the maximum velocity and 
acceleration are requested between pose P2 and pose P3 (1.2 m/s 
and 1.2 G). 

Figures and |7] show the position, velocity and acceler¬ 
ation profiles between Pi to P2 and P2 to P3 in the Cartesian 




(a) Pi to bfPi (b) P2 to P3 

FIGURE 6. Wrist angle velocity and velocity of the end-effector 
along the linear trajectory 

space, respectively. Note that the trajectory between poses P3 
and P 4 is not depicted as it amounts to the one between poses Pi 
and P 2 . 

We can observe that the maximum velocity is reached be¬ 
tween poses P3 and P4 . It means that the projection in the joint 
space of the maximum speed is not greater than the maximum 
velocity or maximum acceleration able to be produced by the 
ball-screws. 

Figures]^ and 1^ show the joint positions and joint velocities 































(a) Pi to P 2 (b) P 2 to P 3 

FIGURE 7. Wrist angle acceleration and acceleration of the end- 
effector along the linear trajectory 


along the three linear trajectories. 
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FIGURE 9. Joint velocities along the complete linear trajectory 




FIGURE 8 . Joint values along the complete linear trajectory 


Circular trajectory 

Table [^describes the path associated with a circular trajec¬ 
tory, the geometric center of the circle being point Pc and its ra¬ 
dius is equal to R. Poses P 2 and P 3 are added before and after the 
circular trajectory, respectively. These poses are defined by the 
radius of the circle, the two angles and r]max define both the 
ends of the arc of circle. Thus, from pose Pi to pose P 2 and from 
pose P3 to pose P4, a linear trajectory is generated. The orienta¬ 
tion of the circular path is characterized by two angles a\ and j3i 
about the z andy axes, respectively. A 2 and B 2 , (A 3 and B 3 , resp.) 
define the orientation of the tool tip for poses P2 and P3. For the 
illustrative example, R — 30mm and A 2 = 20, B 2 = 0, A 3 = 0 and 


TABLE 2. Set of Orthoglide 5-axis end-effector poses used to define 
two linear trajectories and one circular trajectory 



Pi 

Pc 

P4 

a[degres] 

0 

0 

0 

j3 [degres] 

0 

0 

0 

ji[:[mm] 

0 

10 

0 

y[mm] 

0 

10 

0 

z[mm] 

-72 

10 

-72 


Bt, = 20 degrees. 

The local coordinate vector X] of the end-effector is defined 
as: 



xi 


Rcos{ri,„i„ + Arir{t)) 

Xi = 
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Rsm{rimi„+Arir{t)) 
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Its global coordinate vector Xg is defined as: 

Xg = Pc + R(ai)R(/ 3 i)Xi 


The pose of the tool is then defined as: 
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B2 -f (B3 —B 2 )r{t) 

Xc+Xg 

yc+yg 

ZC + Zg 


(27) 
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The local velocity is: 
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And its velocity in the global reference frame is 

X^ = R(ai)R(/3i)Vi (30) 



(a) Pi to P 2 (b) P 2 to P 3 


The velocity is then defined as 


V(t) 


(A 3 -A 2 )f(f) 

Xg 

yg 
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(31) 


Finally, the local acceleration is 
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—R{{r{t)Ari)^cos{Y) -h r{t)Ari sin( 7 ) 
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R{—{r{t)Ari)^ sin{Y) + r{t)Ari cos( 7 ) 




0 


FIGURE 10. Wrist angle and position of the end-effector along the 
circular trajectory 




with 7 = Tjmjn +AT 7 r(f). And the acceleration X^, in the global 
reference frame is 


Xg = R(ai)R(j3i)Ai (33) 


(a) Pi to P 2 (b) P 2 to P 3 

FIGURE 11. Wrist angle velocity and velocity of the end-effector 
along the circular trajectory 


The acceleration is then defined as 


A(t) 


(A 3 -A 2 )f(f) 

{B2-B2)f{t) 

Xg 

yg 


(34) 


Figures [T3] and [T4| show the joint positions and joint veloci¬ 
ties for the complete circular trajectory. During the circular tra¬ 
jectory, the maximum joint acceleration is reached and led to a 
maximum speed reduction. In that case, the execution time of 
the complete trajectory is increased. Then, the coefficient: 7 / 
which is the ratio of the maximum joint velocity to the speed of 
the associated motor and Ja which is the ratio of the maximum 
joint acceleration to the acceleration of the associated motor are 
computed. As a result, the traveling time becomes larger and the 
maximum Cartesian velocity decreases up to 0.6 m/s. 


tf = tfmax{Yv,y/n) (35) 




(a) Pi to P 2 (b) P 2 to P 3 

FIGURE 12. Wrist angle acceleration and acceleration of the end- 
effector along the circular trajectory 


Evaluation of the Orthogide 5-axis performance 

Figures [T^ and show the joint position errors along the 
complete trajectories. It appears that a simple control loop is 
enough when the velocity is low as the corresponding maximum 
error in the actuated prismatic lengths is equal to 0.2 mm. The 
maximum error is reached during the linear trajectory 0.7 mm, 
when the maximum velocity is reached. 

















































FIGURE 13. Joint values along the complete circular trajectory 



FIGURE 15. Joint angles and position errors along the complete lin¬ 
ear trajectory 
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FIGURE 14. Joint velocities along the complete circular trajectory 


Figure [TT] gives the execution time for both trajectories. We 
can notice that the time is stable and close to 10 jls. This time 
includes the computation of the velocity, the direct kinematics 
and othe control loop. As we have a real-time operating sys¬ 
tem, we have also data to send to the computer in which we 
have the Control Desk software able to make data acquisitions. 
Figure[T8]shows the control signal sent to the drive. The variation 
is between -1 and 1, which amount to the maximum continuous 
torques that each motor may produce. For an acceleration equal 
to 1.3 G, it is 80% of the maximum motor torque for the 3'^'^ 
and 4'^' motors. As a consequence, we expect to increase the effi¬ 
ciency of the control loop later on by using a part of peak torques 



FIGURE 16. Joint angles and position errors along the complete cir¬ 
cular trajectory 


in order to reach higher accelerations. 


CONCLUSIONS 

This paper dealt with the kinematic modeling of the Or¬ 
thoglide 5-axis and its use for a computed torque control of the 
semi-industrial prototype. From the semi-industrial prototype 
developed at IRCCyN, we studied the use of this model for gen¬ 
erating movements. We have shown that unlike most of the paral¬ 
lel kinematics machines, the kinematics of the Orthoglide 5-axis 
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(a) 

FIGURE 17. Execution time 
circular trajectory 



(b) 

(a) the linear trajectory and (b) the 



FIGURE 18. Percentage of the motor torques sent to the drives (a) the 
linear trajectory and (b) the circular trajectory 


is rather simple. It was shown that the expressions of the geomet¬ 
ric models and inverse Jacobian matrices are simple to express. 
The assembly of two parallel robots leads to an inverse kinematic 
Jacobian matrix composed of three blocks, the inverse kinematic 
Jacobian matrix of each robot and one additional block corre¬ 
sponding to the coupling between the two parallel robots. For 
performing computed torque control, we have generated a set 
combining positions, velocities and accelerations of the actuators 
that are sent to the control loop. Two types of trajectories were 
studied and validated experimentally. We have shown that for 
linear motions of up to 1 m / s, the tracking error in the actuator 
position is lower than one millimeter. Experiments are ongoing 
to refine the estimate of the masses and inertia in motion and to 
identify the friction parameters. 
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